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Miniature  Aerial  Vehicles  with  four  rotors  is  called  Quad-rotor  MAV, 
popularly  used  in  aspects  of  life  such  military,  civilian  products,  processes 
and  remote  sensor,  etc.  In  this  paper,  the  authors  present  the  suitable  structure 
of  control  system  for  the  Quad-rotor  MAV.  The  first,  the  Six  Degrees  of 
Freedom  (6  DOF)  of  the  Quad-rotor  MAV  dynamic  model  is  built.  After,  the 
control  structure  with  the  single  loop  is  built.  But  in  the  single-loop  system, 
only  four  control  signals  of  Quad-rotor  MAV  can  be  controlled,  so  the  Quad- 
rotor  MAV  can  be  reached  the  height  only  and  keep  the  stability.  However,  it 
is  important  to  note  that  we  have  to  well-known  the  orbit  of  the  Quad-rotor 
MAV  flight;  the  Quad-rotor  MAV  must  fly  point-to-point  exactly,  so  the  six 
coordinate  variables  must  be  controlled.  So,  the  double  loop  control  structure 
system  is  proposed  to  do  that.  Finally,  the  simulation  results  analysis  and  the 
experimental  results  of  the  real  model  are  explored  to  prove  the  effectiveness 
of  the  proposed  structure. 
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1.  INTRODUCTION 

There  is  a  wide  range  of  Unmanned  Aerial  Vehicles  (UAV)  technology  and  satellite  which  under 
development  rapidly  around  the  globe,  provide  for  the  critical  services.  More,  the  technology  of  Micro- 
Electro -Mechanical  is  growing,  used  in  all  the  life  fields  such  as  civilian/commercial  spheres,  the  military 
realm,  information  technology,  processes,  etc,  making  the  aircraft  size  is  smaller,  so  the  application  of 
aircraft  in  the  Miniature  Aerial  Vehicles  (MAV)  field  is  increased.  So,  the  research  on  MAV  is  the  interesting 
topic  in  the  world  [  1  ] ,  [2] . 

The  MAV  is  a  small  unit  which  is  driven  in  conditional  without  the  person  inside,  flight  on  the  aerial 
by  using  the  rotor  thrust  to  overcome  gravity.  So,  MAV  is  the  remote-control  or  an  automatic  unit  with  the 
ability  is  bearing  the  weight  for  any  task.  The  missions  of  MAV  are  intercept,  battle  damage  assessment, 
target  acquisition,  surveillance,  weather  reconnaissance,  and  even  attack  the  targets  directly  with  the  high- 
quality  features. 

In  the  previous  time,  the  MAV  is  used  only  for  the  vertical  takeoff  and  landing  (VTOL)  unit,  so  the 
ability  to  apply  in  practice  is  less.  However,  the  advantage  studies  on  VTOL  MAV  [3] -[5]  prove  that  VTOL 
MAV  can  be  landed  and  taken  off  independently,  flown  in  the  different  environments,  flown  beside,  flown 
back,  flown  forward,  etc.  These  advantages  make  the  application  of  VTOL  MAV  is  more  developed. 

The  new  structure  and  layout  of  VTOL  MAV  with  Quad-rotor  have  been  proposed  in  [6]-[8],  called 
Quad-rotor  MAV  with  the  flyway  is  special.  So,  the  researchers  are  attracted  to  find  out  about  Quad-rotor 
MAV,  which  has  the  machine  structure  is  simpler  than  the  conventional  single-rotor.  Quad-rotor  MAV  can 
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change  the  lifting  force  by  changing  the  speed  of  any  four  rotors,  so  it  can  fly  in  space  more  stable,  can 
change  the  position  and  the  angle  to  achieve  the  different  requirements  of  the  flight  [9], [10].  Quad-rotor 
MAV  can  bear  the  payload  with  more  heavily  than  single -rotor.  Because  the  Quad-rotor  MAV  has  four  rotors 
with  the  symmetric  structure,  there  is  not  the  twisting  moment  which  is  produced  by  each  rotor,  so  it  is  not 
necessary  to  have  an  anti-torque  propeller  [11], [12].  Because  of  their  wonderful  advantage,  Quad-rotor  MAV 
has  been  used  for  making  the  lower  speed  aircraft,  flying  into  the  barrier  area,  and  it  is  suitable  for  a  narrow 
space.  So,  Quad-rotor  MAV  is  the  important  topic  of  study  among  the  researchers  in  the  world.  In  this  paper, 
the  authors  propose  a  novel  structure  of  control  system  for  Quad-rotor  MAV.  Basing  on  the  new  structure, 
the  aircraft  has  excellent  performance,  simple  structure,  low  cost,  and  can  be  applied  in  practice. 


2.  THE  QUAD-ROTOR  MOTION  EQUATION 
2.1.  The  quad-rotor  model 

The  Quad-rotor  has  four  rotors  controlling  four  input  forces  respectively.  The  Quad -rotor  model  is 
shown  in  Figure  1 . 


Figure  1 .  The  Quad-rotor  model  and  the  coordinate  system 


The  overall  force  is  the  sum  of  four  the  rotors  forces.  The  Pitch  movement  is  controlled  by  reducing 
the  front  motor  speed  or  increasing  the  rear  motor  speed.  The  Roll  movement  is  controlled  by  reducing  the 
left  motor  speed  or  increasing  and  the  right  motor  speed.  The  Yaw  movement  is  controlled  by  decreasing  the 
front  motor  speed  or  increasing  the  rear  motor  speed  combined  with  increasing  or  decreasing  the  speed  of  the 
side  motors  [13]-[16]. 

2.2.  The  Quad-rotor  dynamic  equations 

The  Quad-rotor  is  a  multi- variable  and  nonlinear  object  with  4  input  signal  controls  but  with  6 
degrees  of  freedom.  In  order  to  control  the  coordinates  of  Quad-rotor  from  a  point  to  the  other  point  in  the 
space,  it  is  very  important  to  know  the  equations  of  Quad-rotor  dynamic  model,  which  is  shown  as  follows 
[17]-[20]. 
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with  g  is  the  gravitational  acceleration,  m  is  the  weight  of  Quad-rotor,  JTP  is  the  inertia  moment  of  the  rotor.  U h 
U2,  U3,  U4  and  12  are 
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2.3.  The  equations  of  controller  and  other  stages 

The  PID  controller  has  the  equation  in  Laplace  as  follows: 


u(s)  =  (Kp+^ 
s 


+  sKd)e(s) 


(3) 


where:  e  is  the  error  which  is  equal  to  the  set  value  minus  the  real  value.  Kp  is  the  gain  coefficient,  Ki  is  the 
integral  coefficient,  Kd  is  derivative  coefficient,  u  is  the  output  value  of  the  controller. 

In  this  paper,  we  introduce  two  control  structures  for  Quad-rotor.  The  first  is  the  control  structure  with 
the  single  loop  [21],  shown  in  Figure  2.  The  second  is  the  control  structure  with  the  double  loop  [22],  shown  in 
Figure  3.  Both  structures  are  included  of  three  main  parts. 

The  first  part  is  the  controller.  In  the  single  loop  control  structure,  the  controller  is  the  control 
algorithm  block.  In  the  double  loop  control  structure,  the  controller  includes  two  parts,  which  are  the  position 
control  block  and  the  attitude  block  connected  to  each  other.  The  second  part  is  the  inverse  transformation 
block.  This  block  is  built  by  the  equations  shown  as  follows: 


z  =  -g  +  (cos  0  cos  <f))Ul  /  m 

b=u2nx 
e=u 3 
p=u4 


(4) 


After  the  inverse  transformation  block,  we  received  the  signals  shown  as  follows: 


< 
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(5) 


The  third  part  is  the  convert  block  of  rotor  speed.  The  equations  of  this  block  are  as  follows: 
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Figure  2.  The  diagram  of  the  control  structure  with  single  loop 


Figure  3.  The  diagram  of  the  control  structure  with  double  loop 


3.  BUILDING  THE  SIMULATION  MODEL 
3.1.  The  model  of  single  loop  control  structure 

We  make  the  simulation  diagram  on  the  Matlab-Simulink  software.  The  control  structure  with  the 
single  loop  is  shown  in  Figure  4. 
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Figure  4.  The  single  loop  control  structure 


In  Figure  4,  the  input  block  is  the  set  values  of  the  system.  The  control  block  is  presented  in  detail  as 
Figure  5.  The  Motor  block  is  built  according  to  the  equation  (2)  with  the  role  is  converting  the  output  value  of 
controller  into  the  value  of  motor  speed  Qh  Q2,  Q,  The  dynamic  block  is  built  by  the  equations  of  Quad- 
rotor  aircraft  (1).  The  selector  block  is  presented  in  detail  as  figure  6,  with  the  role  is  selecting  the  signals  such 
as  height  (z),  roll  {<j>\  pitch  (0)  and  yaw  (*//)  from  the  dynamic  block  into  the  IMU  block.  The  IMU  block  is  the 
measurement  system  which  measures  height  (z),  roll  (^),  pitch  ( 6 )  and  yaw  ( if /)  signals  send  to  the  controller. 
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Figure  5.  The  internal  structure  of  control  block 


In  Figure  5,  the  input  1  (Ini)  is  the  desired  value  of  the  height  coordinate  (z),  the  input  2  (In2)  is  the 
real  value  of  the  height  coordinate  which  is  measured  by  the  height  sensor.  The  role  of  the  z  PID  controller  is 
controlling  the  height  coordinate  (z),  with  input  value  is  the  error  between  Ini  and  In2.  The  input  3  (In3)  is  the 
desired  value  of  the  angle  coordinate  (roll  (^),  pitch  (0)  and  yaw  (if/)).  The  input  4  (In4)  is  the  real  value  of  the 
angle  coordinate  which  is  measured  by  the  angle  sensor.  There  are  three  angle  controllers  which  are  the  PID 
controllers  for  the  roll  (^),  pitch  (6)  and  yaw  (iff)  angle.  The  output  signals  of  the  control  block  (U  h  U2,  U3,  U4) 
are  through  the  inverse  transform  block  to  convert  into  the  control  signals  as  Qh  f22,  fl3  and  i24.  The  inverse 
transform  block  is  built  according  to  the  equation  (6).  Figure  6  shows  the  Quad-rotor  dynamic  block  which  is 
built  according  to  the  equation  (1). 


Figure  6.  The  Quad-rotor  dynamic  block 
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3.2.  The  model  of  double  loop  control  structure 

The  structure  of  single  loop  control  has  only  four  control  signals,  so  Quad-rotor  MAV  only  can  be 
reached  the  height  and  stability.  However,  it  is  important  to  note  that  we  have  to  well-known  the  orbit  of  the 
Quad-rotor  MAV  flight,  and  in  order  that  Quad-rotor  MAV  can  fly  point-to-point,  six  coordinate  variables 
must  be  controlled.  So  the  double  loop  control  structure  system  is  proposed  to  do  that. 

The  control  structure  with  the  double  loop  is  presented  as  Figure  7,  the  internal  function  blocks  in 
this  control  structure  are  built  according  to  the  equations  (l)-(6). 
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Figure  7.  The  double  loop  control  structure 


There  are  similarities  between  the  double  loop  structure  control  and  the  single  loop  structure  control 
relatively.  However,  there  are  some  differences  as:  the  input  block  in  the  double  loop  structure  includes  six 
desired  values,  which  are  the  x,  y,  z  position  coordinates  and  the  Roll  ((f)).  Pitch  (6),  Yaw  (\jf)  angle  coordinates 
of  the  Quad-rotor.  The  selector  block  is  used  to  select  signals  from  the  dynamic  block  into  the  IMU  block,  those 
selection  signals  after  crossing  IMU  is  the  input  of  the  control  block.  The  difference  of  the  selector  block  in  the 
double  loop  control  structure  is  that  there  are  6  signals  (x,  y,  z  position  coordinates  and  Roll  ((f)).  Pitch  (6),  Yaw 
(yj)  angle  coordinates)  instead  of  4  signals  in  the  single  loop  control  structure.  The  role  of  the  display  block  is 
displaying  the  response  of  position  coordinates  (x,  y,  z)  and  angles  coordinates  ((f),  0,  y/)  of  the  control  system. 

The  control  block  is  shown  in  detail  as  Figure  8.  The  role  of  the  position  control  block  is  controlling 
the  x,y,z  coordinates,  with  the  input  signals  are  Ini  and  In2.  Ini  is  the  desired  values  of  x,  y,  z  coordinates  and 
In2  are  the  real  values  of  v,  y,  z  coordinates  from  the  sensor.  The  role  of  the  transition  block  is  calculating  the 
angles  coordinates  ((f),  6,  y/).  The  role  of  the  attitude  control  block  is  controlling  the  angles  coordinates,  with  Ini 
is  the  desired  value  of  angles  coordinates  ((f),  6,  y/)  from  the  transition  block,  In2  is  the  real  values  of  angle 
coordinates  from  the  sensor.  The  role  of  the  inversion  block  is  converting  the  output  values  of  the  control  block 
into  the  rotor  speed  value  of  four  rotors  Qh  Q2,  O3,  Q4. 
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Figure  8.  Control  blocks  in  the  double  loop  control  structure 


4.  THE  SIMULATION  RESULTS  AND  ANALYSIS 

We  execute  the  simulation  in  two  cases.  The  first  case  is  the  single  loop  structure  control,  the 
control  signals  are  the  height  (z),  roll  ((f)),  pitch  (0)  and  yaw  (y/)  coordinates.  The  second  case  is  the  double 
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loop  structure  control,  the  control  signals  are  the  xjz  position  coordinates  and  the  Roll  (^),  Pitch  (0),  Yaw 
( y /)  angle  coordinates. 

4.1.  In  the  case  of  single  loop  structure 

After  many  experimental  studies,  the  parameter  values  of  the  PID  controller  for  the  height  (z),  roll 
(^),  pitch  ( 0 )  and  yaw  (y/)  coordinates  are  shown  in  Table  1.  Then,  we  test  the  ability  of  Quad-rotor  to  fly  in 
space  with  the  initial  angles  ((/),  0,  y/)  is  (0.2,  0.2,  0.5)  rad.  The  simulation  results  are  shown  in  Figure  9. 


Table  1.  The  single  loop  control  structure  parameters 


Kp 

Ki 
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Height 

24.1 
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20.2 

Roll 

0.80 
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Pitch 
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Figure  9.  The  simulation  results  of  the  single  loop  control  structure:  (a)  Response  of  z;  (b)  Response  of  Roll; 

(c)  Response  of  Pitch;  (d)  Response  of  Yaw 


The  simulation  results  show  that  the  initial  angles  are  not  balanced,  after  controlling  (after  the  3rd 
second),  the  angle  coordinates  ((/),  0,  y/)  are  balanced  with  the  values  (0,  0,  0).  The  height  coordinate  (z) 
reaches  equilibrium  at  the  height  of  0.5  m.  After  the  transition  time,  all  coordinates  have  good  equilibrium,  it 
is  confirmed  that  the  control  structure  works  well  and  efficiently. 

4.2.  In  the  case  of  double  loop  structure 

In  the  double  loop  structure  control,  we  set  the  parameter  values  of  the  PID  controller  for  the 
position  coordinates  (x,y,z)  and  roll  (^),  pitch  ( 0 ),  yaw  (yj)  coordinates  as  in  Table  2.  Running  the  Quad-rotor 
fly  from  the  position  coordinates  (x,y,z)=(0,  0,  0)  to  (0.1,  0.1,  1)  m,  and  the  angular  coordinates  ((/>,0,y/) 
change  the  desired  value  from  (0,  0,  0)  to  (0.1,  0.1,  1)  rad,  the  simulation  results  are  shown  in  the  Figure  10. 
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Table  2.  The  double  loop  control  structure  parameters 


Kp 

Ki 

Kd 

X 

0.078 

0.0009 

0.39 

Y 

0.078 
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0.39 
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24.1 
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0.19 

Figure  10.  The  simulation  results  of  double  loop  control  structure:  (a)  Response  of  Roll; 

(b)  Response  of  Pitch;  (c)  Response  of  Yaw;  (d)  Response  of  x;  (e)  Response  of  y;  (f)  Response  of  z 


The  simulation  results  in  Figure  10  show  that  the  roll  (^),  pitch  (9),  yaw  (y/)  coordinates  attain  the 
desired  coordinates  after  about  4  seconds,  the  position  coordinates  ( x,y,z )  attain  the  desired  coordinates  after 
about  10  seconds.  After  the  transition  time,  all  coordinates  are  stable,  it  is  confirmed  that  the  double  loop  control 
structure  can  control  the  Quad-rotor  fly  point-to-point  well  and  efficiently. 


5.  THE  EXPERIMENTAL  RESULTS 

After  constructing  the  control  structure  for  Quad-rotor  and  defining  the  control  parameters,  we 
install  on  the  real  device,  the  Quad-rotor  MAY  model  is  shown  as  Figure  1 1 . 
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Figure  1 1 .  The  Quad-rotor  MAY  model 


Testing  the  system  in  the  laboratory  with  the  environment  no  disturbances  caused  by  the  wind.  We 
control  the  angular  coordinates  (<j),6,y/)  changing  the  value  from  (-38,-20,-68)  to  ( 0 ,  0,  -40)  degree,  and  the  v, 
y  and  z  coordinates  changing  the  value  from  (0.2,  0.4,  0.4)  to  (0.8, 0.6, .07)  m ,  the  experiment  results  are 
shown  in  Figure  12,  which  includes  the  real  signal  values  of  Roll,  Pitch,  Yaw  angle  coordinates  and  the  v,  y,  z 
position  coordinates. 
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Figure  12.  The  experiment  results:  (a)  Roll  Stabilization;  (b)  Pitch  Stabilization;  (c)  Yaw  Stabilization; 
(d)  Response  of  v;  (e)  Response  of  y;  (f)  Response  of  z 


Int  J  Pow  Elec  &  Dri  Syst,  Vol.  9,  No.  4,  December  2018  :  1634  -  1643 


Int  J  Pow  Elec  &  Dri  Syst 


ISSN:  2088-8694 


□  1643 


The  experiment  results  show  that  the  responses  of  Roll,  Pitch,  Yaw  coordinates  (f,Q,\if)  and  the  v,  y 
and  z  coordinates  are  good,  all  coordinates  attain  the  desired  value  after  about  4  seconds.  However,  the 
angular  coordinates  have  the  fluctuation  about  ±5  degrees.  The  amplitudes  of  this  fluctuation  are  small  and 
acceptable.  So  it  is  confirmed  that  the  system  control  worked  well  and  efficiently. 


6.  CONCLUSION 

In  this  research,  the  authors  have  proposed  two  control  structures  for  the  Quad-rotor,  particularly  in 
the  control  system  structure  with  the  double  loop.  The  simulation  results  are  presented  to  prove  that  six 
coordinates  (x,y,z,(/),6,y/)  can  be  controlled  by  four  rotors,  so  the  Quad-rotor  can  fly  point-to-point  exactly  in 
the  space.  Then,  the  experimental  results  make  certain  that  the  Quad-rotor  can  go  to  the  desired  position  and 
the  desired  direction  with  the  short  transition  time,  so  the  proposed  control  structure  can  be  applied  in  practice 
with  the  low  cost  and  the  high-efficiency. 
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